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(54) GAIT GENERATING DEVICE FOR LEG TYPE MOVING ROBOT 



(57) In a gait generation system for a legged mobile 
robot, in particular a legged mobile robot having a body 
and a plurality of legs links each connected to the body 
through a joint, it is configured such that gaits compris- 
ing motion parameters and floor reaction force parame- 
ters are varied freely on a real-time basis during 
walking. In order to effect this, various standard gaits 
have been prepared on an off-line computer and an 
approximated value such as a weighted average thereof 
is calculated in response to a demand for gait, and gaits 
are generated. Moreover, the gaits are corrected using 
an inverted pendulum model such that positions and the 
velocities are continuous at the boundary of the gaits. 
With the arrangement, it becomes possible to generate 
gaits having the floor reaction force freely on a real-time 
basis to effect a stride or turning angle as desired. It 
also becomes possible to make the displacements and 
velocities of various portions of the robot continuous at 
the boundary of the gaits. In addition, it becomes possi- 
ble to control the legged mobile robot based on the gaits 
thus generated on a real-time basis. 
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Description 

TECHNICAL FIELD TO WHICH THE INVENTION RELATES TO 

[0001 ] The present invention relates to a gait generation system of a legged mobile robot, and more particularly to 
a system for generating or determining a gait freely on a real-time basis. 

BACKGROUND ART OF THE INVENTION 

[0002] In a conventional gait generation of a legged mobile robot, as taught in Japanese Laid-Open Patent Appli- 
cation No. Hei 5 (1993) - 285,868, various gaits in time-series data including that for walking straight or that for turning 
are designed using an offline computer. The data are then loaded to a memory of a microcomputer mounted on the 
robot which outputs the data successively to be processed during walking. 

[0003] Moreover, Japanese Laid-Open Patent Application No. Sho 62 (1987) - 97.006 (Japanese Patent Publica- 
tion No. Hei 5 (1993) - 62,363) proposes to prepare similar locomotion pattern time-series data beforehand using an 
offline computer and to load the data to the memory of the on-board microcomputer which outputs the data succes- 
sively during walking, and to interpolate the adjacent time-series data to shorten the time interval (i.e., increase the 
sampling rate). 

[0004] Since, however, the gait data have been prepared beforehand, the prior-art techniques fail to generate a gait 
freely on a real-time basis during walking such that the robot may, for example, change its stride or the angle of turning 
as desired. 

[0005] A first object of the present invention is to solve the drawbacks of the prior art and to provide a gait genera- 
tion system of a legged mobile robot which generates, freely on a real-time basis, a gait taking onto account the floor 
reaction force such that a desired stride or a desired angle of turning, etc is realized. 

[0006] A second object of the present invention is to solve the drawbacks of the prior art and to provide a gait gen- 
eration system of a legged mobile robot which generates a gait freely on a real-time basis such that a displacement and 
a (displacement) velocity of a robot portion are continuous at the boundary of the gaits thus generated. 
[0007] A third object of the present invention is to solve a drawback of the prior art and to provide a gait generation 
system of a legged mobile robot which controls the locomotion of the robot based on a gait generated on a real time 
basis. 

DISCLOSURE OF THE INVENTION 

[0008] In order to achieve the first and second objects, the present invention provides a system for generating a gait 
of a legged mobile robot having at least a body and a plurality of leg links each connected to the body through a joint, 
comprising standard gait storing means for storing, in memory, a plurality of standard gaits, for at least one walking step, 
each comprising a set of parameters including a parameter relating to a floor reaction force, gait demanding means for 
making a demand for gait, and gait generating means for generating an approximated gait which satisfies the demand 
for gait by selecting one or a plurality of the standard gaits in response to the demand for gait, and by conducting 
approximation based on the selected standard gait or gaits. 

[0009] It is configured such that said gait generating means generates the approximated gait by calculating a 
weighted average of the selected gaits. 

[0010] It is configured such that said gait generating means generates the approximated gait by using a parameter 
sensitivity of the selected gait or gaits. 

[0011] It is configured such that said gait generating means generates the approximated gait by calculating a 
weighted average of the selected gaits and by using a parameter sensitivity of the selected gait or gaits. 
[0012] It is configured such that said gait generating means includes storing means for determining an amount of 
change in one parameter relative to a unit amount of change in another parameter in at least one of the standard gaits, 
as the parameter sensitivity of the selected gait and for storing the parameter sensitivity in memory, and generates the 
approximated gait by using the stored parameter sensitivity. 

[0013] It is configured such that said gait means incudes describing means for describing a relationship of pertur- 
bation of one parameter relative to the parameter relating to the floor reaction force in the standard gaits, and corrects 
the approximated gait based on the described relationship of perturbation to generate gaits which satisfy the demand 
for gait in such a manner that at least displacements and velocities in the generated gaits are continuous at a boundary 
of the gaits. 

[0014] It is configured such that the perturbation of the one parameter is a perturbation of a horizontal body posi- 
tion. 

[0015] It is configured such the relationship is described by a linear model. 
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[0016] It is configured such that the relationship is described by an inverted pendulum model. 
[0017] It is configured such that the relationship is described by time-series tabulated data. 
[0018] It is configured such that said gait generating means generates the approximated gait without considering 
the parameter if it is under a predetermined condition. 
5 [0019] It is configured such that said gait generating means includes joint angle command calculating means for 
calculating a joint angle command of the robot based on the generated gait, and joint controlling means for controlling 
the joint of the robot such that it traces the calculated joint angle command 

[0020] It is configured such that said joint angle command calculating means includes detecting means for detect- 
ing a state of the robot, and correcting means for correcting a position and a posture of the robot in response to the 
10 detected state, and calculates the joint angle command such that the corrected position and the orientation are 
effected. 

BRIEF DESCRIPTION OF THE DRAWINGS 
is [0021] 

Figure 1 is a schematic view showing an overall configuration of a gait generation system of a legged mobile robot 
according to the present invention; 

Figure 2 is a block diagram showing details of a control unit of a biped robot illustrated in Figure 1 ; 
20 Figure 3 is a block diagram showing the operation of the gait generation system of a legged mobile robot according 
to the present invention; 

Figure 4 is a main flow chart showing the operation of the gait generation system of a legged mobile robot accord- 
ing to the present invention; 

Figure 5 is an explanatory view showing the free leg position and orientation in standard gait No. 0 from among the 
25 standard gaits used in the gait generation shown in Figures 3 and 4; 

Figure 6 is an explanatory side view showing the feet trajectory in standard gait No.O illustrated in Figure 5; 
Figure 7 is a time chart showing the trajectory of the ZMP (in the X-coordinate or direction) in standard gait No.O 
illustrated in Figure 5; 

Figure 8 is an explanatory view showing the free leg position and orientation in standard gait No. 1 from among the 
30 standard gaits used in the gait generation shown in Figures 3 and 4; 

Figure 9 is a time chart showing the trajectory of the ZMP (in the X-coordinate or direction) in standard gait No. 1 
illustrated in Figure 8; 

Figure 10 is an explanatory view showing the free leg position and orientation in standard gait No. 2 from among 
the standard gaits used in the gait generation shown in Figures 3 and 4; 
35 Figure 11 is a time chart showing the trajectory of the ZMP (in the X-coordinate or direction) in standard gait No.2 
illustrated in Figure 10; 

Figure 12 is an explanatory view showing the free leg position and orientation of a demanded gait demanded in the 
gait generation shown in Figures 3 and 4; 

Figure 1 3 is a time chart showing the trajectory of the ZMP (in the X-coordinate or direction) in the demanded gait 
40 illustrated in Figure 12; 

Figure 14 is a flow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 4; 

Figure 15 is an explanatory view explaining the operation of the flow chart of Figure 14; 

Figure 16 is an explanatory view explaining, similarly to Figure 15, the operation of the flow chart of Figure 14; 

Figure 17 is a flow chart showing the subroutine of the calculation of instantaneous values of the desired gait 
45 referred to in the flow chart of Figure 4; 

Figure 18 is a flow chart showing a double-leg compliance control proposed earlier by the applicant which will be 

conducted based on the gait generated in the gait generation shown in Figures 3 and 4; 

Figure 19 is a flow chart showing the subroutine of calculating a manipulated variable of the double-leg compliance 
control illustrated in the flow chart of Figure 18; 
so Figure 20 is a main flow chart, similar to Figure 4, but showing the operation of the system according to a second 
embodiment of the present invention; 

Figure 21 is a flow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 20; 
Figure 22 is a flow chart showing the subroutine of the calculation of instantaneous values of the desired gait 
referred to in the flow chart of Figure 20; 
55 Figure 23 is a main flow chart, similar to Figure 4, but showing the operation of the system according to a third 
embodiment of the present invention; 

Figure 24 is a flow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 23; 

Figure 25 is a flow chart showing the subroutine of the calculation of instantaneous values of the desired gait 
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referred to in the flow chart of Figure 23; 

Figure 26 is a main flow chart, similar to Figure 4, but showing the operation of the system according to a fourth 
embodiment of the present invention; 

Figure 27 is a time chart showing the gait such as a body position generated in the fourth embodiment of the 
present invention; 

Figure 28 is a time chart showing the trajectory of the ZMP (in the X-coordinate or direction) for explaining how to 
accord the conditions of boundary with each other referred to in the flow chart of Figure 26; 
Figure 29 is a time chart showing the trajectory of the ZMP (in the X-coordinate or direction) for explaining the oper- 
ation illustrated in the flow chart of Figure 26; 

Figure 30 is a time chart showing the trajectory of the ZMP (in the X-coordinate or direction) for similarly explaining 
the operation illustrated in the flow chart of Figure 26; 

Figure 31 is a time chart showing the trajectory of the ZMP (in the X-coordinate or direction) for similarly explaining 
the operation illustrated in the flow chart of Figure 26; 

Figure 32 is a time chart showing the trajectory of the ZMP (in the X-coordinate or direction) for similarly explaining 
the operation illustrated in the flow chart of Figure 26; 

Figure 33 is a f taw chart showing the subroutine of gait mixing referred to in the flow chart of Figure 26; 

Figure 34 is a flow chart showing the subroutine of the calculation of instantaneous values of desired gait referred 

to in the flow chart of Figure 26; 

Figure 35 is time chart showing the gait generated in the fourth embodiment illustrated in the flow chart of Figure 
26; 

Figure 36 is a main flow chart, similar to Figure 4, but showing the operation of the system according to a fifth 
embodiment of the present invention; 

Figure 37 is an explanatory view showing an inverted pendulum model used in the fifth embodiment; 
Figure 38 is a flow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 36; 
Figure 39 is a flow chart showing the subroutine of the calculation of instantaneous values of the desired gait 
referred to in the flow chart of Figure 36; 

Figure 40 is a main flow chart, similar to Figure 4, but showing the operation of the system according to a sixth 
embodiment of the present invention; 

Figure 41 is a time chart showing the operation of the sixth embodiment illustrated in figure 40; 
Figure 42 is a flow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 40; 
Figure 43 is a flow chart showing the subroutine of the calculation of instantaneous values of the desired gait 
referred to in the flow chart of Figure 40; 

Figure 44 is a time chart showing the operation illustrated in the flow chart of Figure 40; 

Figure 45 is a block diagram, similar to Figure 3, but showing the configuration and operation of the system accord- 
ing to a seventh embodiment of the present invention; 

Figure 46 is a main flow chart showing the operation of the system according to the seventh embodiment of the 
present invention; 

Figure 47 is a flow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 46; 

Figure 48 is a flow chart showing the subroutine of the calculation of instantaneous values of the desired gait 

referred to in the flow chart of Figure 46; and 

Figure 49 is an explanatory view showing the body position in the gait generated by the gait generation system of 
a legged mobile robot according to the present invention. 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 

[0022] The gait generation system of a legged mobile robot according to the present invention will be explained with 
reference to the accompanied drawings. A biped robot is taken as an example of a legged mobile robot. 
[0023] Figure 1 is a schematic view showing an overall configuration of the system including a biped robot 1 accord- 
ing to the present invention. 

[0024] As illustrated in the figure, the robot 1 has a pair of laterally spaced leg links 2 each composed of six joints. 
In a simple representation, each of the joints is represented by an electric motor which actuates the joint. The joints 
include, arranged successively downward, a pair of joints 10R, 10L (the right-hand joint is indicated by R and the left- 
hand joint by L) for rotating legs with respect to hips, a pair of joints 14R, 14L for rolling movement with respect to hips 
about an X-axis within a frontal plane, a pair of joints 12R, 12L for pitching movement with respect to hips about a Y- 
axis within a sagittal plane, a pair of knee joints 16R, 16L for pitching movement with respect to knees, a pair of joints 
18R, 18L for pitching movement with respect to ankles, and a pair of joints 20R 20Lfor rolling movement with respect 
to ankles. 

[0025] The robot 1 is provided with feet 22 R, 22L and has a body (trunk) 24 as its uppermost portion which houses 
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therein a control unit 26 comprising microcomputers which will be described later with reference to Figure 2. The joints 
10R(L), 12R(L), 14R(L) make up hip joints, and the joints 18R(L), 20R(L) make up ankle joints. The hip joints and knee 
joints are connected to each other by thigh links 28R, 28L ( and the knee joints and ankle joints are connected to each 
other by crus or shank links 30 R, 30 L 
s [0026] With the above structure, each of the leg links 2 is given six degrees of freedom. When the 6 * 2 - 12 joints 
are driven to suitable angles while the robot 1 is walking, a desired motion is imparted to the entire leg structure to 
cause the two-legged walking robot 1 to walk arbitrarily in a three-dimensional environment. (In the specification, "*" 
represents multiplication.) 

[0027] It should be noted that, throughout the description, the position and velocity of the body 24 are used to rep- 
10 resent those of a representative position such as the position of the center of gravity of the body 24 and (displacement) 
velocity thereof. 

[0028] As shown in Figure 1, a known six-axis force and torque sensor 44 is disposed below the ankle joints for 
measuring three directional components Fx, Fy, Fz of force and three directional components Mx, My, Mz of torque or 
moment thereby to detect whether the foot 22R(L) has landed or not, or if a load or force is acting on the robot through 
15 the foot assembly when it contacts the floor. The body 24 has an inclination sensor 60 for detecting tipping or inclination 
in the frontal plane with respect to a Z-axis (the direction of gravity) and its angular velocity (rate), and also a tilt in the 
sagittal plane with respect to the Z-axis and its angular velocity. The electric motors of the respective joints are coupled 
with respective rotary encoders for detecting angular displacements of the electric motors. 

[0029] Although not shown in Figure 1 , the robot 1 is configured to have a joystick 62 at an appropriate position 
20 thereof, through which an operator can input a demand for the gait to change to another gait such as making the robot, 
when walking straight, to turn. 

[0030] Figure 2 is a block diagram which shows the details of the control unit 26, which is comprised of microcom- 
puters. Outputs from the inclination sensor 60, etc., are convened by an A/D convener 70 into digital signals, which are 
transmitted through a bus 72 to a RAM 74. Output signals from the rotary encoders that are disposed adjacent to the 

25 respective electric motors are transmitted through a counter 76 to the RAM 74. 

[0031] The control unit 26 includes first and second calculators 80, 82 comprising CPUs. The first calculator 80 
generates a gait freely on a real-time basis during walking using standard gaits prepared beforehand and stored in a 
ROM 84, calculates desired joint angles based on the generated gait, and outputs to the RAM 74. The second calcula- 
tor 82 reads the desired joint angles and detected values from the RAM 74, and outputs manipulated variables through 

30 a D/A convener 86 and servo-amplifiers to the electric motors provided at the respective joints. 

[0032] Figure 3 is a block diagram which shows the operation of the system according to the present invention in a 
functional manner, while Figure 4 is a flow chart (called a "structured flow chart") showing the procedures of gait mixing 
or gait generation illustrated in the block diagram. In the specification, the gait generation is sometimes referred to as 
"gait mixing". 

35 [0033] Explaining first the gait to be generated by the system, the present invention aims to provide a system which 
generates a gait on a real-time basis as mentioned above. More specifically, the present invention aims to generate a 
gait which is necessary for conducting the robot posture stability control utilizing the double-leg compliance control pro- 
posed earlier by the applicant in Japanese Laid-Open Patent Application No. Hei 5 (1993) - 305,585. 
[0034] To facilitate understanding, the posture stability control proposed earlier will briefly be explained. In the con- 

40 trol, the error between a desired value and the detected value of the floor reaction force (ZMP) is first determined, and 
either or both of the legs are moved to decrease the error, thereby effecting posture stability. When the robot is about 
to tip over, the desired floor reaction force is intentionally deviated or shifted so as to deviate or shift the actual floor 
reaction force, thereby restoring robot posture stability. 

[0035] In a legged mobile robot, thus, it is impossible to ensure stable walking or locomotion unless the relation- 
45 ships among the desired motion trajectories and the desired floor reaction force pattern satisfy the dynamic equilibrium 
condition. To satisfy the dynamic equilibrium condition means, to be more specific, that the central point of the desired 
floor reaction force (the point of action on the floor at which the secondary moment of the desired floor reaction force 
becomes zero) is equal to the ZMP (Zero Moment Point; the point on the floor at which the moment of the resultant force 
of the inertial force due to motion and gravity is zero except for its vertical component). If they do not accord with each 
so other, when the compliance control is operative, the robot loses dynamic equilibrium between the resultant force and 
the floor reaction force and will tip. 

[0036] In the compliance control proposed earlier, this is deliberately utilized to restore stability when the robot is 
about to tip or turn over. As was understood from the above, the legged mobile robot should have, as desired values in 
the control of locomotion, not only the desired motion pattern, but also the desired floor reaction force pattern satisfying 
55 the dynamic equilibrium condition relative to the desired motion pattern. 

[0037] The desired floor reaction force is generally described by a point of action and by a force and moment acting 
thereat. Since the point of action can be set at any point, the desired floor reaction force has numerous descriptions. 
However, if the desired floor reaction force is described by taking the aforesaid central point of the desired floor reaction 
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force as the point of the action, the moment, acting at the point, of the resultant force is zero except for its vertical com- 
ponent. 

[0038] As stated above, since the trajectory of the central point of the desired floor reaction force (which satisfies 
the dynamic equilibrium condition relative to the desired motion trajectories) is equal to the ZMP, the desired ZMP tra- 
5 jectory can be used in lieu of the desired floor reaction force central point trajectory. 

[0039] Therefore, the above can be rewritten as; "the legged mobile robot should have, as desired values in the 
control of locomotion, not only the desired motion patterns or trajectories, but also the desired ZMP trajectory (desired 
floor reaction force pattern)". Based on the above, the desired gait is defined in this specification as follows. 

10 a) The desired gait is, in a broad sense, a set of the desired motion trajectories and the desired floor reaction force 
pattern over a period of a walking step or steps. 

b) The desired gait is, in a narrower sense, a set of the desired motion trajectories and the ZMP trajectory for a 
period of a single walking step. 

c) A series of walking is comprised of a series of gaits. 

15 

[0040] Hereinafter, for a more rapid understanding, the desired gait is used to represent that gait defined in the nar- 
rower sense, unless it is mentioned to the contrary. Specifically, the desired gait is used to mean a gait for a period 
beginning from the initial state of a double-leg supporting phase to the final state of a single-leg supporting phase that 
follows. Here, needless to say, the double-leg supporting phase means a period during which the robot 1 supports its 
20 weight with two leg links 2, whereas the single-leg supporting phase means a period during which the robot supports 
its weight with one of the two leg links 2. The leg (link) which does not support the robot weight during the single-leg 
supporting phase is called the free leg, while the other the supporting leg. 

[0041] The object of the present invention is to generate the desired gait defined above freely and on a real-time 
basis. If such a gait can be generated freely on a real-time basis, it becomes possible, for example, for an operator to 
25 manipulate the robot 1 by remote control. Moreover, in manipulating the robot automatically, it becomes possible not 
only to control the robot to walk in accordance with a predetermined sequence, but also to guide the robot to walk along 
a path or to effect high precision positioning. 

[0042] Here, the conditions which the desired gait should satisfy will be explained. 

[0043] The conditions which the desired gait should satisfy will generally be classified into the following five condi- 
30 tions. 

Condition 1 ) The desired gait must satisfy the dynamic equilibrium condition. In other words, the ZMP trajectory cal- 
culated dynamically in response to the desired motion trajectories of the robot 1 should accord with the desired 
ZMP trajectory. 

35 Condition 2) When a demand(s) such as a change in stride or in the angle of turning is made by a locomotion plan- 
ner or path planner (neither shown) of the robot 1 or by an operator through the joystick 62, the desired gait should 
satisfy such a demand(s). 

Condition 3) The desired gait should satisfy conditions of constraint in kinematics such as that the robot foot must 
not dig or scrape the floor on which it walks, the joint angle must be within the movable range, and the joint angular 
40 velocity must not exceed the permissible range. 

Condition 4) The desired gait should also satisfy conditions of constraint in dynamics such as the ZMP having to 
remain within the foot sole floor-contact area during the single-leg supporting phase, and that the joint torque must 
not exceed the possible maximum power of the joint actuators. 

Condition 5) The desired gait should satisfy conditions of boundary. As a matter of course, condition 1 results in the 
45 condition of boundary that the position and velocity of robot portions such as the body must be continuous in the 
gait boundary. (If not, infinite force would occur or the ZMP would move far from the foot sole floor-contact area). 

[0044] More specifically, the final state of n-th gait should correspond to the initial state of n+1 -th gait, especially in 
the body position, orientation and velocity relative to the feet position and orientation. More specifically, if the initial state 
so of n+1 -th gait is already determined, it suffices if the final state of n-th gait is accorded with the n+1 -th gait initial state. 
[0045] If not determined, it suffices if the final state of n+1 -th gait is within a range that ensures continuous walking 
without losing posture stability. However, as will be discussed later, it is quite difficult to determine the final state range 
which ensures continuous walking without losing posture stability. 

[0046] Generally speaking, the desired gait is generated by a gait generation algorithm including parameter values 
55 or time-series tabulated data, like the standard gaits explained later. (In other words, to determine the gait means to 
determine the parameter values or time-series tabulated data appropriately.) 

[0047] Various gaits can be generated by changing the parameter values or time-series tabulated data. However, if 
the parameters or time-series tabulated data are determined without paying careful attention, it is uncertain whether the 



6 



BNSDOCID: <EP 1018467A1_L> 



EP1 018 467 A1 

generated gait can satisfy all of the conditions mentioned above. 

[0048] In particular, when generating the body trajectories satisfying condition 1) based on the ZMP trajectory by a 
gait generation algorithm, even when the ranges, suitable for continuous walking, of the body position and velocity at 
the gait end or final state are known, it is difficult to determine the parameters relating to the ZMP trajectory such that 
5 both the body position and velocity will fall within the range at the gait end. 
[0049] The reasons of the difficulty are as follows. 

Reason 1) The robot body tends to move farther from the ZMP, once initially moved away from the ZMP. This will 
be explained using an inverted pendulum model which approximates the behavior of the robot body. 

io If the inverted pendulum's supporting point deviates from the projection point of the center of the gravity of the 

pendulum projected to the floor, the deviation tends to increase, and the pendulum turns over. Even when the pen- 
dulum is turning over, the resultant force of the inertial force and gravity of the inverted pendulum is acting on the 
supporting point (in other words, the ZMP is kept equal to the supporting point, and the resultant force is kept bal- 
anced with the floor reaction force acting through the supporting point. The dynamic equilibrium condition merely 

15 describes an instantaneous relationship between the inertial force and gravity and the floor reaction force of a mov- 
ing object. 

It is a frequent misconception that continuous robot walking can be ensured if the dynamic equilibrium condi- 
tion is satisfied. However, satisfaction of the dynamic equilibrium condition will not ensure that the robot does not 
lose a stable posture during walking. Just as the center of gravity of the inverted pendulum tends to move farther, 
20 if moved from the position immediately above the supporting point, the center of gravity of the robot tends, once 
moved from the position immediately above the ZMP, to move farther therefrom. 

Reason 2) The single-leg supporting phase requires that the ZMP must be within the supporting leg foot sole floor- 
contact area. Due to rigid conditions of constraint such as this, it is difficult to determine the body acceleration and 
deceleration patterns. If the body patterns are determined mainly taking body position into account, the velocity 
25 would tend to be out of range at the gait end, and vice versa. An analogy when driving a vehicle, is to stop the vehi- 
cle at a predetermined stopping position at a designated time, while limiting braking force to within a narrow preset 
range. 

[0050] Thus, it has hitherto been difficult to generate or determine the desired gait parameters or tabulated data, 
30 on a real-time basis, which will satisfy all of the possible gait conditions. The aforesaid prior art techniques described in 
the references hence could not effect free robot walking. 

[0051 ] Based on the above, the system according to the present invention will be explained with reference to Figure 
3. The figure, a block diagram, shows the system in a functional manner so as to facilitate understanding of the opera- 
tion of the system illustrated in Figure 4. 
35 [0052] In the system illustrated, the gait(s) is generated in a mixed gait instantaneous value generator on the basis 
of a set or group of standard gaits (which have been generated on an offline computer and stored in the ROM 84) in 
such a manner that the generated gait satisfies a demand for gait (such as to change gaits) made on a real-time basis 
during walking. 

[0053] The standard gaits have been prepared by an offline computer by selecting gaits, through trial-and errors, 

40 which ensure a long continuous period of walking up to the final step, without causing the robot body trajectory to 
diverge, and have been stored in the ROM 84. The standard gaits which ensure a long continuous period of walking are 
typically comprised of a series of gaits having a gait to start walking from a standing position, a gait for accelerating the 
walking speed, a gait for constant speed walking, a gait for decelerating the walking speed, and a gait to stop walking. 
[0054] The gait is described by gait parameters. The gait parameters are comprised of motion parameters and the 

45 ZMP parameter (more generally floor reaction force parameter). The "floor reaction force parameter" is used in this 
specification to mean a parameter relating to the floor reaction force pattern with respect to time. 
[0055] The ZMP trajectory has a zig-zag pattern, and the ZMP parameter is described in the coordinate of X, Y and 
Z (directions) by the positions of the braking points and passing times as is shown in Figure 7. (The ZMP is referred to 
only in the X-coordinate.) In the mixed gait instantaneous value generator, instantaneous values of ZMP (trajectory), 

so i.e., values at current (current time) control cycle are calculated in a ZMP generator based on the ZMP parameters. 
[0056] The motion parameters are comprised of feet (trajectory) parameters and the body (trajectory) parameters. 
[0057] The feet trajectory parameters are comprised of initial free leg (foot lifting) position and orientation, final free 
leg (foot landing) position and orientation, and the periods or times of the double-leg supporting phase and the single- 
leg supporting phase, etc. Based on these, instantaneous values of the positions (xf, yf, zf) and orientations (6 xf, 6 yf, 

55 e zf) of both feet are determined by a feet trajectory generator in accordance with the technique proposed earlier by the 
applicant in Japanese Laid-Open Patent Applications Hei 5 (1993) - 318,339 and Hei 5 (1993) - 324,1 15. Here, the word 
"orientation" means inclination or direction in space. 

[0058] The body trajectory parameters include parameters defining the body orientation (the direction or inclination 



7 



3NSDOCID: <EP 1018467A1_I_> 



EP1 018 467 A1 



of the body 24 in space), the body height (a value in the Z-direction), initial body position (displacement) and velocity, 
etc. 

[0059] Based on the parameters determining the body position and orientation, instantaneous values of the hori- 
zontal position (xb, yb) and orientation (6 xb, 0 yb, 0 zb) of the body are generated in a horizontal body position gener- 
5 ator in accordance with time functions or the technique proposed earlier by the applicant in Japanese Laid-Open Patent 
Application Hei 5 (1993) - 324,115. The body position is, as mentioned earlier, the position of the representative point 
such as the center of mass of the body 24. The height of body zb is determined in a body height determinator using an 
appropriate technique such as that described in a patent application filed by the applicant on the same date as the 
present invention. 

io [0060] Since the legged mobile robot 1 has 1 2 joints as illustrated in Figure 1 , joint angles are deterministically cal- 
culated by an inverse kinematic solution from the obtained feet positions and orientations and the body position and ori- 
entation. More specifically, the current desired robot posture is solely determined. (More precisely, the desired feet 
positions and orientations are subject to correction in a double-leg compliance controller and based on the corrected 
values (if corrected), the desired joint angles are calculated.) 

15 [0061] The gaits are deterministically described by the gait parameters. In this embodiment, however, in order to 
reduce the volume of calculation, standard gait body trajectories have been prepared in advance by an offline computer 
as time-series tabulated data to be stored in memory, whereby data corresponding to the control cycle is successively 
output. When the capacity of the ROM 84 is relatively small, it is alternatively possible to approximate the standard gait 
body trajectories using a polynomial and coefficients of the polynomial are stored in memory as a kind of gait parame- 

20 ter, although this does lead to a small approximation error. 

[0062] Hereafter, the standard gaits are further explained. The standard gaits are described in this specification as 
time functions. Each standard gait is described by a set g(t) and f(t) defined as follows. 

g(t): functions describing the motion of the robot. (Specifically, the functions represent the positions and orienta- 
ls tions of the robot components at time t, more specifically, the motion of the robot is described by the positions and 
orientations of the robot body and feet as shown in Figure 3); 

f(t): functions describing ZMP trajectory. Specifically, the functions represent, as mentioned above, the positions (x, 
y, z) of the ZMP at time t. 

30 [0063] The gait functions are described by symbols in view of the parameters. To be more specific, g(t) and f(t) are 
functions which are defined by the gait parameters. Although it is preferable that all the parameters are represented, so 
as to clearly indicate gaits, since the number of parameters is large, only those parameters necessary for the following 
explanation are described here. 

35 g(t: a, b, c, d, x(k), y(k)): functions describing robot motion trajectories; 

f(t: a, b, c, d): functions describing the ZMP trajectory (functions describing the floor reaction force). 



[0064] In the representation, the time-series data is treated as a kind of parameter. Inherently, without a time-series 
table describing the body position, the gait is solely or deterministically determined when the parameters of the initial 
body position and velocity are given. The body position time-series data is thus redundant. However, in order to shorten 
so the gait generation time on a real-time basis, the body position time-series data table is treated here as a kind of param- 
eter describing gaits. 

[0065] In this embodiment, the initial body position and velocity parameters are different for different gaits. Since, 
however, the initial body position and velocity can be calculated when the body position time-series data are described 
explicitly, no further explanation is made here. 
55 [0066] In the embodiment, the standard gaits such as that for beginning walking from standing position are pre- 
pared using an offline computer as mentioned above. The following three gaits are examples. 

standard gait No. 0 



where: 



40 



45 



a: initial free leg foot orientation (indicative of the turning angle of the robot) 
b: initial free leg foot positions in the to-and-fro direction (walking stride) 
c: the X-coordinate of ZMP in the single-leg supporting phase 
d: the Y-coordinate of ZMP in the single-leg supporting phase 
x(k): the X-coordinate of body positions in time-series 
y(k): the Y-coordinate of body positions in time-series. 
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g(t: aO, bO, cO, dO, 
f(t: aO, bO, cO, dO) 



xO(k), yO(k)) 



standard gait No. 1 



5 



g(t: a1, bO, d, d1, 
f(t: a1 t bO, d, d1) 



x1(k), y1(k)) 



standard gait No. 2 



10 



g(t: aO, b2, c2, d2, 
f(t: aO, b2, c2, d2) 



x2(k), y2(k)) 



[0067] Figures 5 to 1 1 illustrate the initial free leg foot positions and orientations, and the final free leg foot positions 
15 and orientations, etc. In order to describe the gaits, the coordinate system is set with a reference point on the supporting 
leg foot sole floor-contact surface as the origin, and the to-and-fro direction of the supporting leg foot as the X-direction 
and the left-to-right direction as the Y-direction. 

[0068] Before entering into the explanation of the flow chart of Figure 4, assume that the demand for gait is given 
as shown in Figures 12 and 13 and taking as an example the generation of the demanded gait (the aforesaid approxi- 
20 mated gait, referred to hereinafter as "3rd gait") for satisfying the demand using the standard gaits, the operation of the 
system is explained. The demanded gait should have been given initial free leg orientation a3 and to-and-fro position 
b3. 

[0069] Apparently, the parameter a is a3 and b is b3 in the 3rd gait. The problem is how to determine the other 
parameters c, d and the tabulated values x(k), y(k) so as to satisfy the demand. 
25 [0070] The 3rd gait is therefore described as follows; 

g(t: a3, b3, c3, d3, x3(k), y3(k)) 
f(t: a3, b3, c3, d3). 

30 [0071 ] Then the parameters c3, d3 and the time-series tabulated data x3(k) and y3(k) are determined. 

[0072] Here, the terms are defined. The parameters a, b include values input as a request (same as the aforesaid 
demand for gait) from outside of the system (such as by an operator via the joystick 62) or through another system (such 
as from the double-leg compliance controller in the block diagram of Figure 3). The parameter whose value is 
demanded directly to be a determined value is called "directly-determined parameter". 

35 [0073] In order to simplify the explanation, it is described in this embodiment that only the initial free leg foot orien- 
tation and to-and-fro position (stride) can be changed at discretion. Moreover, the following 1) and 2) can be input as 
the demand for gait, as mentioned above. In addition, 3) can also be input which will be mentioned in the fourth embod- 
iment of the present invention. 

40 1) instructions from an operator (e.g., instructions on turning angle or turning angular velocity, or locomotion speed) 

2) demand from other system such as a path guidance system, if any (e.g., final free leg foot position and orienta- 
tion) 

3) boundary conditions of gaits between the current gait and the preceding or next gait (e.g., initial body position 
and orientation, initial free leg foot position and orientation). 



[0074] On the other hand, parameters such as c, d, or the tabulated data x(k), y(k) are called dependent parame- 
ters (or tabulated data), which are determined based on the directly-determined parameter such that they satisfy the 
gait conditions. Since it is quite difficult to directly determine the time-series tabulated data, the time-series tabulated 
data is rarely a directly-determined parameter. 
so [0075] The aforesaid standard gaits No. 1 or No. 2 (other than the standard gait No. 0) are based on the standard 
gait No. 0 and only one of the directly-determined parameters, (i.e. a or b) differs from that of standard gait No. 0). The 
basic gait among the selected standard gaits, (i.e., standard gait No. 0) is called the base gait 

[0076] The determination of the demanded gait parameters (the demanded gait parameters are referred to some- 
times as "mixed parameters" in this specification) will be explained. The dependent parameters c3, d3 and the depend- 
55 ent tabulated data x3(k), y3(k) vary in response to the directly-determined parameters a, b so as to satisfy the 
conditions of gait. Moreover, it is supposed that they vary continuously in response to the change in the parameters a, 
b. The values are therefore continuous functions of the parameters a, b. This means that the following principle of 
approximation can be utilized or applied. In other words, the demanded gait parameters can be calculated by approxi- 
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mation method. 

[0077] To be more specific, if function p is a continuous function, it can be approximated using the following expres- 
sion. 

P(a0+Aa, bO+Ab) - P(a0, bO) + 5P/5a| (a = aO, b = bO) * Aa+ 6P/5b| (a - aO, b = bO) * Ab 
Approximation 1 

here, 

6P/6a| (a=a0,b=b0) is a partial differential of P relative to a at a = aO , b = bO ; 
6P/6b| (a=aO,b=bO) is a partial differential of P relative to b at a=aO , b=bO . 
[0078] Moreover, since 

5P/6a| (a = aO, b = bO) = (P(aO + Aa1 . bO) - P (aO. bO))/Aa1 
6P/ 6b| (a = aO, b = bO) = (P(aO, bO +Ab2) - P (aO, bO))/Ab2 
[0079] Approximation 1 can be rewritten as follows. 

P(aO + Aa, bO + Ab) = P(aO, bO) + {P(aO + Aal, bO) - P(aO, bO)}/Aal * Aa + {P(aO, bO + Ab2) - P(aO, bO))/Ab2 * Ab 
Approximation 2. 

[0080] The first embodiment is a development of Approximation 2 and the second embodiment (explained later) is 
a development of Approximation 1 . 

[0081] Continuing the explanation of the demanded gait parameters, the 3rd gait parameters are calculated from 
the standard gaits by dividing internally or externally (i.e., interpolating) all the dependent parameters and time-series 
tabulated data using the following equations. This is because it can be considered that the dependent parameters are 
in proportion to the directly-determined parameters. 

[0082] If a3 is between a1 and a2, it is calculated by internal division, and rf a3 is not between a1 and a2, it is 
obtained by external division. When the difference in the parameter can be neglected in the sense of dynamics, the 
parameter may be the same as that in the base gait. If the time-series tabulated data is calculated in the first calculator 
80 at one time, the load of calculation becomes great. Thus, the internal or external division should accordingly be con- 
ducted only for data in the current control cycle. 

[0083] The followings are the aforesaid equations for mixing (referred to later as "Eqs. 1 ") using internal or external 
division. 

c3 = CO + (d - cO) * (a3 - a0)/(a1 -aO) + (c2 - cO) * (b3 - b0)/(b2 - bO) 

d3 = dO + (d1 - dO) * (a3 - a0)/(a1 -aO) + (d2 - dO) * (b3 - b0)/(b2 - bO) 

x3(k) = x0(k) + (x1(k) - xO(k)) * (a3 - aO)/(a1 - aO) + (x2(k) - x0(k)) * (b3 - bO)/ (b2 - bO) 

y3(k) = y0(k) + (y1 (k) - y0(k)) * (a3 - a0)/(a1 - aO) + (y2(k) - y0(k)) * (b3 - bO)/ (b2 - bO) 

[0084] These Eqs. 1 are weighted average calculations of the standard parameters and tabulated data. For exam- 
ple, the equation for obtaining c3 can be rewritten as follows. 

c3={1-(a3-a0)/(a1 - aO) - (b3-b0)/(b2-b0)} *c0+(a3-a0)/(a1-a0)*c1 + (b3 - b0)/(b2 - bO) * c2. 

[0085] Since the sum of the weighted coefficients of cO, c1 , c2 is 1 , c3 is a weighted average whose weights of cO, 
d and c2 are respectively; 

{1 - (a3 - aO)/ (al - aO) - (b3 - b0)/(b2 - bO)} 
(a3 - aO)/(ai -aO) 
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(b3 - b0)/(b2 - bO). 

[0086] If the final body position and orientation should be varied at discretion as a directly-determined parameter, 
it suffices if a weighted average of the base gait and some standard gait whose ZMP parameters are different from each 
5 other is calculated. Since the final state of the mixed gait is nearly equal to the weighted average of the final states of 
the standard gaits including the base gait to be mixed, it suffices if the weights of the weighted average are determined 
such that the final state of the mixed gait (including the to-and fro position and velocity of the body) are identical to the 
demanded value. 

[0087] If the body position is determined from the time-series tabulated data, the mixed gait will entirely satisfy the 
10 demanded value with respect to the final state conditions. However, when the body position is determined sequentially 
by dynamics calculation such that the determined ZMP trajectory is satisfied, as will be described in the seventh 
embodiment, it deviates to a small extent. 

[0088] In determining the weights, each final state of the standard gaits to be mixed should be known. If the final 
states of the standard gaits have been prepared as tabulated data and stored in memory, it becomes possible to reduce 
is the calculation time. 

[0089] In the manner explained above, the mixed gait parameters are determined, and instantaneous values of the 
demanded gait at each time are generated or determined in the same way as the gait generation algorithm of the stand- 
ard gait prepared by an offline computer. 

[0090] Based on the above, the operation of the system according to the invention will be explained with reference 
20 to a flow chart shown in Figure 4. The program begins at S10 in which the standard gait data prepared by an external 
computer have been loaded to or stored in the ROM 84. The program proceeds to S12 in which final body positions and 
velocities in each standard gait are calculated and stored in the memory. 

[0091] Since the body position has been prepared as a function x(k), y(k) as mentioned above, the body velocity 
should be calculated from the final value and the value preceding the final value in the tabulated data. More specifically, 
25 the final value in the tabulated data is immediately determined as the position, and the difference between this value 
and the value preceding the final value is calculated and is used to determine the velocity. 

[0092] The program then proceeds to SI 4 in which the timer value t is reset to zero (in other words, the timer is 
started), to S18, via S16, in which a timer interrupt is waited for (the timer is different from that in S14). The procedures 
shown in the flow chart of Figure 4 are executed once per predetermined period such as 20 msec, i.e., the control cycle 

30 is 20 msec. 

[0093] The program then proceeds to S20 in which it is determined whether the gait is at the time of, switching (the 
end of a single walking step), or more specifically whether it is the time for switching the waking step. When the result 
is affirmative, the program proceeds to S22 in which the timer is reset to zero, to S24 in which the demanded value for 
gait, specifically the demanded value of the directly-determined parameters at the current gait (the new gait which 
35 begins from this time), i.e. the aforesaid a and k are read. 

[0094] The program then proceeds to S26 in which procedures for gait mixing are conducted. 
[0095] Figure 14 is a flow chart showing the subroutine of the gait mixing procedures. 

[0096] The program begins at S100 in which one standard gait whose directly-determined parameters are close to 
the demanded value is selected as the base gait. Explaining this with reference to Figure 15, since the standard gait 
40 whose directly-determined parameters a, b are close to the demanded value (3rd gait's) a3, b3, is standard gait No. 0, 
the standard gait No. 0 is selected as the base gait. 

[0097] The program then proceeds to S102 in which, noticing the above-mentioned directly-determined parame- 
ters, standard gaits are separately selected which are different in one of the directly-determined parameters from that 
of the base gait. When there are plural candidates, the standard gait whose parameter is as close as possible to the 
45 noticed parameter should be selected. It is preferable to select the standard gait whose parameter sandwiches the 
demanded value with the base gait parameters. Specifically when the situation is as shown in Figure 16, standard gait 
No. 1 should preferably be selected with respect to the parameter a. 

[0098] As will be explained in the fifth embodiment, when the mass of leg links 2 is sufficiently smaller than that of 
the body 24, the inertial force generated by the robot 1 will change little if the final free leg foot position and orientation 
50 in the directly-determined parameters vary slightly. In other words, the change of the parameters would not influence 
the other parameters in satisfying the dynamic equilibrium condition. 

[0099] Accordingly, if the final free leg foot position and orientation parameters differ slightly from those of the base 
gait, this can easily be solved by changing the base gait parameter values as demanded. By doing so it becomes 
unnecessary to select standard gaits to be mixed, whose final free leg foot position and orientation parameters are only 
55 different from those of the base gait. 

[0100] The program then proceeds to S104 in which the demanded values are substituted for the directly-deter- 
mined parameters of the mixed gait, to S106 in which the dependent parameters of the mixed gait are calculated using 
the equations for parameter calculation (Eqs. 1). 
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[0101] Returning to the explanation of Figure 4, the program then proceeds to S28 in which the mixed gait param- 
eters (tabulated values) are substituted for the desired gait parameters (tabulated data), to S30 in which the instanta- 
neous values (i.e., the values at the current control cycle) of the desired gait are calculated. 
[0102] Figure 1 7 is a flow chart showing the subroutine of the procedures. 
s [0103] Explaining this, the program starts at S200 in which the ZMP at time t is determined or calculated based on 
the mixed gait parameters, to S202 in which the feet position and orientation are determined or calculated based on the 
mixed gait parameters using the aforesaid technique proposed earlier. 

[0104] The program proceeds to S204 in which the body height at time t is determined or calculated from the feet 
position and orientation at time t and the horizontal body position at time t - At. Since the details of this are described in 
10 another patent application filed at the same time as the present invention as mentioned above, and have no direct rela- 
tionship with the gist of the present invention, explanation is omitted. 

[0105] The program proceeds to S206 in which the horizontal body position of the mixed gait at time t is calculated 
based on the body position at time t of the selected standard gaits (including the base gait) in accordance with the afore- 
said equations for mixing (Eqs. 1). 
15 [0106] Returning to the explanation of Figure 4, the program proceeds to S32 in which time t is updated by At and 
returns to S18 to repeat the procedures mentioned above. 

[0107] Based on the gait thus generated, the double-leg compliance control is conducted, if necessary, by the dou- 
ble-leg compliance controller and the desired joint angles are determined. The joints are then controlled to trace the 
desired joint angles. 

20 [0108] The double-leg compliance control will be explained briefly with the reference to the flow chart of Figure 18. 
[0109] In the flow chart, the program starts at S300 in which a manipulated variable of the double-leg compliance 
control is calculated. 

[0110] Figure 19 is a flow chart showing the subroutine of the procedures. Explaining the flow chart, the program 
begins at S400 in which the output from the 6-axis force and torque sensor 44 is read, and proceeds to S402 in which 

25 the actual position of the ZMP (the actual floor reaction force central point) is determined, to S404 in which the deter- 
mined value is compared with the desired ZMP position and the difference therebetween, i.e., the direction of difference 
and the amount of difference X are determined, to S406 in which the manipulated variable of the feet is determined in 
accordance with the equation illustrated there, to S408 in which the feet position and orientation are deviated or shifted 
by the determined manipulated variable. The actual ZMP position and the actual floor reaction force central point are 

30 equal to each other, hence they are treated as the same in this specification. 

[01 1 1 ] Returning to the explanation of the flow chart of Figure 18, the program proceeds to S302 in which desired 
angles of the 12 joints are calculated by a known inverse kinematic solution based on the feet positions and orientations 
(corrected feet positions and orientations if corrected in the compliance controller) and the body position and orienta- 
tion. The program proceeds to S304 in which the desired posture is corrected so as to intentionally deviate or shift the 

35 floor reaction force central point, when the robot 1 is determined to be unstable from the output of the inclination sensor 
44. The program proceeds to S306 in which all joints are driven to trace the desired joint angles. Specifically, this is con- 
ducted by the second calculator 82. 

[0112] Having been configured in the foregoing manner, the system in the first embodiment can generate a gait 
freely on a real-time basis and can effect a desired stride or turn in a desired angle. Moreover, the system can make the 

40 legged mobile robot walk freely by driving the joint angles based on the gait generated on a real-time basis. 

[0113] More specifically, the system can freely generate an approximate gait on a real-time basis which satisfies 
the aforesaid conditions of gait or the demand for gait by appropriately selecting some of gait as the base gait from 
among the stored standard gaits in response to the demand on the stride or turning angle, and by mixing (such as syn- 
thesizing, modification, etc.), i.e., by conducting approximation. 

45 [01 14] Moreover, with the arrangement, the system can freely generate a gait having an accurate stride or turning 
angle, and by combining and mixing the standard gaits, can generate at discretion an average gait therebetween. 
[0115] Furthermore, the system can reduce the amount or volume of calculation. More particularly speaking, the 
amount of calculation on the first calculator 80 will be reduced by 90%, compared with a case in which the robot dynam- 
ics problem is solved on a real-time basis. Moreover, as the appropriate standard gaits are stored in advance and a gait 

so is newly generated by mixing the standard gaits together, it becomes possible to reduce the amount or capacity of mem- 
ory (the ROM 84). Furthermore, as the standard gaits can be prepared optimally, it becomes possible to generate eas- 
ily, without trial and error, a new gait which satisfies the conditions 1) to 5) mentioned above. 

[0116] Figure 20 is a flow chart showing the operation of the system according to the second embodiment of the 
present invention. 

55 [0117] In the second embodiment, in addition to the standard gaits, a sensitivity of a gait parameter is used. The 
"sensitivity" generally means the ratio of the response or change induced in the output to a stimulus or change in the 
input. In the second embodiment, an amount of change in one gait parameter per unit amount of change in the other 
gait parameter is determined or calculated. The amount of change in one gait parameter is referred to as "gait param- 
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eter sensitivity" and is used to determine the amount of change (or variation) of a parameter. 

[0118] Described simply, gait parameter sensitivity refers to how much the dependent parameters should be 
changed or varied in order that the changed gait keeps desirable conditions if and when the directly-determined param- 
eters (such as the initial free leg foot orientation a, the initial free leg foot to-and-for position £ in the first embodiment) 
5 are changed by a small amount. Thus, the gait parameter sensitivity is defined as the amount of dependent parameter 
change per unit amount of the directly-determined parameters. 

[01 1 9] In the second embodiment, as a result, the number of standard gaits are reduced and only those suitable for 
the base gait are used. More specifically, the standard gaits comprising a series of continuous gaits having a gait to start 
walking from a standing position, a gait for accelerating the walking speed, a gait for constant speed walking, a gait for 
10 decelerating the walking speed, and a gait to stop walking, are similarly used. However, no other standard gaits whose 
parameters are slightly different from those of the series of successive gaits are prepared. 

[0120] To be more specific, the sensitivity of a parameter g relative to a parameter q in a standard gait i is described 
as Di (q,p). In the tabulated data, the sensitivity of k-th datum x(k) relative to the parameter q is similarly described as 
Di (x(k), p). 

is [0121] The generation of the demanded gait in the second embodiment will be explained. 

[0122] The relationships between the parameter c's sensitivity relative to the parameter a in standard gait No.O 
(referred to as D0(c, a)) and those in standard gait No. 1 will be shown as follows in accordance with the definitions, 
when (a1 - aO) is sufficiently small. 

20 DO (c, a)=(c1 - c0)/(a1 - aO) 

DO (d, a) = (d1 - d0)/(a1 -aO) 

DO (x(k), a) = (x1(k) - xO(k)) /(a1 - aO) 

DO (y(k), a) = (y1(k) - yO(k)) /(a1 - aO) 

[0123] Similarly, the relationships between the parameter c's sensitivity relative to the parameter b in standard gait 
No. 0 (referred to as DO(cb)) and those in standard gait No. 2 will be shown as follows in accordance with the defini- 
te tions, when (b2 - bO) is sufficiently small. 

DO (c, b) « (c2 - cO) /(b2 - bO) 
DO (d, b) = (d2 - d0)/(b1 - bO) 

35 

DO (x(k), b) = (x2(k) - xO(k)) /(b2 - bO) 

DO (y(k), b) = (y2(k) - yO(k)) /(b2 - bO) 

40 [01 24] The following will be obtained as equations for parameter determination (hereinafter referred to as "Eqs. 2"), 
by substituting these in the equations for mixing the parameters and tabulated data in the first embodiment. 

c3 = cO + D0(c, a) * (a3 - aO) + DO (c, b) *(b3 - bO) 

45 d3 m dO + D0(d. a) * (a3 - aO) + DO (d, b) *(b3 - bO) 

x3(k) =xO(k) + D0(x(k), a) *(a3 - aO) + D0(x(k), b) * (b3 - bO) 

y3(k) = yO(k) + D0(y(k), a) *(a3 - aO) + D0(y(k), b) * (b3 - bO) 

50 

[0125] Based on the above, the operation of the second embodiment will be explained with reference to Figure 20. 
The program begins at S500 in which the base gaits and gait parameter sensitivities prepared by an offline computer 
have been stored in memory and then proceeds to S502 and to S5 14 to conduct the same procedures as those of the 
first embodiment, then to S516 in which the procedures for gait mixing are conducted. 
55 [0126] Figure 21 is a flow chart for showing the subroutine of the procedures. The program begins at S600 in which 
the base gait whose directly-determined parameters are close to the demanded values is selected, and proceeds to 
S602 in which the demanded values are substituted for the directly-determined parameters of the mixed gait, to S604 
in which the dependent parameters are calculated in accordance with Eqs. 2. The tabulated data of the horizontal body 
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position may be calculated at one time. However, since the volume of calculation thereof is great, each value necessary 
for the current control cycle may be calculated in the subroutine of the instantaneous value calculation explained later. 
[0127] Returning to the explanation of Figure 20, the program proceeds to S520, via S518, in which the instanta- 
neous values of the desired gait are calculated. 
5 [0128] Figure 22 is a flow chart showing the subroutine of the procedures. The program begins at S700 and then 
proceeds to S702 and to S706 in which the positions and orientations of the feet and body are calculated. In S706, the 
horizontal body position is calculated in accordance with the equations relating to x t y in Eqs. 2. Returning to the expla- 
nation of Figure 20, the program returns, via S522, to S508 to repeat the procedures. 

[0129] Having been configured in the foregoing manner, the system in the second embodiment has the same 

10 advantages as those of the first embodiment. 

[0130] However, the superiority of the second embodiment over the first embodiment depends on the combination 
of the standard gaits or the nature or characters of the standard gaits being stored in memory. For example, naming all 
space generated by the combinations of the directly-determined parameters as a parameter space, the first embodi- 
ment may be configured such that the directly-determined parameters are discretized for a certain interval in such a 

15 manner that lattice-like discrete spaces are prepared in the parameter space, and desired standard gaits are prepared 
for all the combination of the directly-determined parameters in the discrete spaces. To be more specific, the first 
embodiment may be configured such that the parameters other than the directly-determined parameters, i.e., the 
dependent parameters, are adjusted so that the gaits become desirable gaits. 

[0131] If the first embodiment is provided with the standard gaits prepared in the above-mentioned manner, most 
20 of standard gaits can satisfy the condition to be the base gait. (The standard gait whose directly-determined parameters 
are entirely same as those of the other existing standard gait, except for any one parameter, can satisfy the conditions 
as the base gait.) If the first embodiment is modified as above, no parameter sensitivity is needed for generating gaits 
freely. 

[0132] it should be noted in the second embodiment that, when the parameter sensitivities are almost equal for var- 
25 ious gaits, the parameter sensitivities need not be prepared for each gait, but one may be prepared that is common for 
al! the gaits. With the arrangement, the capacity of the memory (the ROM 84) can be reduced to a great extent com- 
pared to that in the first embodiment. 

[0133] For example, if D0(c, a), D1(c, a), D2(c, a)...Dn(c, a) are almost the same, the average value D(c, a) thereof 
can instead be used in ail the equations for parameter determination. 
30 [0134] Figure 23 is a flow chart showing the operation of the system according to the third embodiment of the 
present invention. 

[01 35] in the third embodiment, both the standard gaits used in the first embodiment and the parameter sensitivities 
in the second embodiment are used. 

[0136] The generation of a demanded gait in the third embodiment is now explained. 
35 [0137] In the third embodiment, when calculating the dependent parameter values, the influence of the directly- 
determined parameters are determined partially by using the method of the first embodiment, while the rest of the influ- 
ence is determined using the method of the second embodiment. More precisely, gait mixing as well as an addition of 
perturbation due to the gait parameter sensitivity are used. 

[0138] To be more specific, if using the first embodiment for the influence of the directly-determined parameter a 
40 and the second embodiment for that of the parameter the equations for parameter determination will be rewritten as 
follows. 

c3 = cO + (d - cO) * (a3 - aO) /(a1 - aO) + DO (c, b) *(b3 - bO) 
45 d3 = d0 + (d1 -dO) * (a3-a0)/(a3-a) + DO (d,b) * (b3-b0) 

x3(k) = x0(k) + (x1(k) - x0(k)) * (a3 - a0)/(a1 - aO) + DO (x(k), b) * (b3 - bO) 
y3(k) = y0(k) + (y1(k) - y0(k)) * (a3 - a0)/(a1 - aO) + D0(y(k), b) * (b3 - bO) 

so 

[0139] Explaining the operation with reference to Figure 23, the program begins at S800 in which the standard gaits 
and gait parameter sensitivities prepared by an offline computer and stored in memory are read, and proceeds to S802 
and on in which the same procedures as the first embodiment are taken, to S900 and onward, via S816, as described 
in a flow chart of Figure 24 in which the gait mixing is conducted. Then, the program proceeds from S820 in the flow 
55 chart of Figure 23 to S1000 and onward in a flow chart of Figure 25 in which the instantaneous values are calculated. 
[0140] Having been configured in the foregoing manner, the system in the third embodiment has the same advan- 
tages of the foregoing embodiments. 

[0141] Figure 26 is a flow chart showing the operation of the system according to the fourth embodiment of the 
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present invention. 

[0142] As illustrated in Figure 27, the body positions and orientation in the mixed gaits (demanded gait) obtained 
from the standard gaits tend to be slightly discontinuous with each other at the gait boundary. The final body position 
and velocity of one mixed gait should therefore be accorded with the initial body position and velocity of the next mixed 

5 gait. In view of this, the fourth embodiment is configured such that the boundary conditions of the body position and ori- 
entation can freely be determined. In other words, the initial and final body positions and velocities are deemed as the 
directly-determined parameters, enabling the body position and velocity to be continuous at the gait boundary. 
[0143] Summarizing this method, the mixed gait is first generated in which all the directly-determined parameters 
(except for those of the initial and final body positions and velocities) are as desired, using any method from the first to 

io third embodiments. Then, the ZMP parameters are corrected in order that the initial and final body positions and veloc- 
ities are as desired 

[0144] Since the former of these procedures are the same as those of foregoing embodiments, explanation is omit- 
ted. The explanation will only be made on the latter of these procedures for correcting the ZMP parameters such that 
the initial and final body positions and velocities become as desired. 

15 [0145] In the gait generation described in the foregoing embodiments, assume that the gait parameters (except for 
the initial body position and velocity, the final body position and velocity and the ZMP parameters) are fixed. 
[0146] Under the assumption, when the initial body position and velocity and the ZMP parameters are determined, 
a gait satisfying the dynamic equilibrium condition is deter mi nistically obtained. As a result, the final body position and 
velocity are deterministically obtained. On the other hand, giving the final body position and velocity and the ZMP pat- 

20 tern will deterministically yield the initial body position and velocity. This means that, in order to freely determine the ini- 
tial body position and velocity and the final body position and velocity, the ZMP pattern should be adjusted in response 
thereto. Saying this in reverse, if the ZMP pattern has once been determined, the relationship between the combination 
of the initial body position and velocity and the combination of the final body position and velocity is one-to-one map- 
ping. 

25 [0147] In order to simplify the explanation, only the behavior of the body to-and-fro direction (i.e., the X-direction) 
will be discussed. Since the quantities of state are two parameters, i.e., the position and velocity, the ZMP pattern 
should have two or more parameters in order that the gait conditions thereof can freely be determined. 
[0148] Here, the ZMP patterns and its parameters are defined as shown in Figure 28 such that the boundary body 
position and velocity can be changed greatly if the ZMP parameters are changed by a small amount. 

30 [0149] The ZMP pattern illustrated in the figure is more complicated than those in the foregoing embodiments. The 
reason is that, if a similar ZMP pattern to any in the foregoing embodiments is used, in addition to the parameter c, 
another parameter in time t2 (which does not influence the foot trajectory) must also be varied. However, even if the 
parameter in time t2 is varied greatly, the boundary body position and velocity will only be corrected by a small amount. 
[0150] In the fourth embodiment, the ZMP parameter can be determined using any method in the first or second 

35 embodiments. In the fourth embodiment, accordingly, using the third embodiment method, a correction amount for the 
ZMP parameters and corrected body trajectories are determined in the manner explained below. The correction amount 
for the ZMP parameters is a correction amount to be added to the mixed gait ZMP parameter in order that the boundary 
body conditions of the mixed gait become desired values. 

[0151] Explaining the operation of the system according to the fourth embodiment with reference to Figure 26, the 
40 program begins at Si 100 in which the standard gaits prepared on an offline computer have been stored in memory sim- 
ilarly to the foregoing embodiments, and proceeds to S1 102 in which the final body positions and velocities of the vari- 
ous standard gaits are determined and stored in memory, to S1 104 in which the following procedures are taken. 
[0152] Specifically, as illustrated in Figure 29. the ZMP parameter c in the mixed gait is slightly perturbed by an 
amount Ac and in response thereto, a perturbation amount A x(k) of the body position time-series tabulated data to be 
45 perturbed is calculated so as to satisfy the dynamic equilibrium condition. The relationship between these quantities is 
defined as follows. 

Rmix (x(k), c) * Ax(k)/Ac 

so [0153] Here, Rmix(x(k), c) (which corresponds to the aforesaid gait parameter sensitivity) is called a partial differ- 
ential sensitivity of x(k) relative to c. Similarly, as illustrated in Figure 30, Rmix (x(k), e) is determined relative to the ZMP 
parameter e. 

[0154] In the second embodiment, when determining the sensitivity of x(k) relative to a certain parameter noticed, 
dependent parameters other than x(k) or the noticed parameter are adjusted for, while keeping the optimum of the gait 
55 as the conditions of constraint. On the contrary, in the fourth embodiment, all the parameters (other than the noticed 
parameter and x(k)) are made fixed and the sensitivities are determined, while ignoring the optimum of the gait. Figu- 
ratively speaking, the second embodiment determines total differential values deeming the gait optimum as the condi- 
tions of constraint, whereas the fourth embodiment determines partial differential values without paying attention to the 
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gait optimum. 

[0155] Returning to the explanation of Figure 26, the program proceeds to S1 106 in which based on the final values 
and on the values immediately preceding thereto of Rmix(x(k), c) and Rmix (x(k), e), a partial differential sensitivity 
Rmix (Xe, c) of the final body position and a partial differential sensitivity Rmix (Ve, c) relative to the mixed gait ZMP 
5 parameter c, a partial differential sensitivity Rmix (Xe, e) of final body position and a partial differential sensitivity Rmix 
(Ve, e) relative to the mixed gait ZMP parameter e are calculated as follows. 

Rmix (Xe, c) = Rmix (x(ke), c) 

10 Rmix (Ve, c) = (Rmix(x(ke), c) - Rmix(x(ke-1), c)}/At 

Rmix (Xe, e) = Rmix (x(ke), e) 

Rmix (Ve. e) = {Rmix(x(ke), e) - Rmix(x(ke-1), e)}/At 

15 

Here, ke: final number of tabulated data, At: sampling time, more precisely sampling interval in discrete-time series of 
tabulated data. 

[0156] The program proceeds to S1 108 in which a matrix of dimension 2*2 having Rmix(Xe, c) as the element of 
the 1st row 1st column, Rmix(Xe, e) as the element of the 1st row 2nd column, Rmix(Ve, c) as the element of the 2nd 

20 row 1st column, Rmix(Ve. e) as the element of the 2nd row 2nd column, is generated. 

[01 57] The program proceeds to S1 1 1 0 in which the inverse matrix of the matrix just generated is calculated. In the 
inverse matrix, the element of the 1st row 1st column is a partial differential sensitivity of the parameter q relative to the 
final body position Xe (referred to as Rmix(c, Xe)), the element of the 2nd row 1st column is a partial differential sensi- 
tivity of the parameter e relative to the final body position Xe (referred to as Rmix(e, Xe)), the element of the 1st row 2nd 

25 column is a partial differential sensitivity of the parameter c relative to the final body velocity Ve (referred to as Rmix(e, 
Xe)), and the element of the 2nd row 2nd column is a partial differential sensitivity of the parameter e relative to the final 
body velocity Ve (referred to as Rmix (e, Ve)). 

[0158] If these sensitivities change little in all of the mixed gaits, the average values thereof R(c, Xe), R(e, Xe), R(c, 
Ve), R(e, Ve) may instead be used for all the gaits. 
30 [01 59] The program proceeds to S1 1 1 2 in which the initial body position in the mixed gait is shifted or perturbed by 
a small amount AxO as illustrated in Figure 31, and a body position time-series tabulated data perturbation amount A 
x(k) is determined in response thereto so as to satisfy the dynamic equilibrium condition. The value is obviously as fol- 
lows. 

35 Ax(0)=AxO 
[0160] Rmix (x(k), xO) is determined as follows. 

Rmix(x(k), xO) =A x(k)/Ax0 

40 

[0161] Similarly, the initial body velocity is shifted or perturbed by a small amount Av0 f as illustrated in Figure 32 
and Rmix(x(k), vO) is determined in a similar manner. 

[01 62] The program then proceeds to S1 1 1 4 in which based on the final values and on the values immediately pre- 
ceding thereto of the determined sensitivities Rmix(x(k), xO) and Rmix (x(k), vO), a partial differential sensitivity of the 
45 final body position and a partial differential sensitivity relative to the initial body position in the mixed gait (referred to as 
Rmix (Xe, xO) and Rmix (Ve, xO)), a partial differential sensitivity of final body position and a partial differential sensitivity 
relative to the initial body velocity in the mixed gait (referred to as Rmix (Xe, vO) and Rmix (Ve, vO)) are calculated as 
follows. 

so Rmix (Xe, xO) = Rmix (x(ke), xO) 

Rmix (Ve, xO) = {Rmix(x(ke), xO) - Rmix(x(ke-1), x0)}/At 
Rmix (Xe, vO) = Rmix (x(ke), vO) 

55 

Rmix (Ve, vO) = {Rmix(x(ke), vO) - Rmix(x(ke-1), v0)}/At 
Here, ke: final number of tabulated data, At: sampling time of tabulated data. 
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[0163] The program then proceeds to S1 116 in which the timer is reset to zero and is started, to S1 120, via S1 118, 
in which the timer interrupt is waited for, to S1 122 in which it is determined whether the gait is to be switched. When the 
result is affirmative, the program proceeds to Si 1 24 in which the timer is reset to zero, to S1 1 26 in which the demanded 
values of the directly-determined parameters are read, then to S1 1 28 in which the gait mixing is conducted. 
5 [0164] Specifically, the program proceeds to S1 200 of the subroutine flow chart of Figure 33 in which the mixed gait 
parameters are generated using any method in the first to third embodiments. In this mixed gait parameter generation, 
one from among gaits the whose initial and final body positions and velocities are close to the demanded values, is 
selected as the base gait. 

[0165] However, once selected as the base gait, the initial and final body positions and velocities are excluded from 
10 the directly-determined parameters, and the mixed gait is generated in the same manner as the foregoing embodi- 
ments. 

[0166] The program then proceeds to S1202 in which the differences between the demanded initial body position 
and velocity and the mixed gait initial body position and velocity are calculated. The differences are named AxO, AvO. 
Similarly, the differences between the demanded final body position and velocity and the mixed gait final body position 
is and velocity are calculated, and are named AXe, AVe. 

[0167] The program proceeds to S1204 in which only the initial body position and velocity in the mixed gate are 
replaced with the demanded initial body position and velocity. Then final body position and velocity perturbation 
amounts of the gait when the body position time-series tabulated data are perturbed in response thereto such that the 
dynamic equilibrium condition is satisfied (referred to as AXse, AVse), are calculated by the following equations. 

20 

AXse = Rmix (Xe, xO) * AxO + Rmix (Xe, vO) * AvO 

AVse = Rmix (Ve, xO) * AxO + Rmix (Ve, vO) * AvO 

25 [0168] In the gait obtained in S1204, the initial body position and velocity accord with the demanded values. How- 
ever, the final body positions and velocity are not equal to the demanded final body position and velocity, and differ by 
AXe+AXse and AVe+A Vse. The program therefore proceeds to SI 206 in which ZMP parameter correction amounts Ac 
and Ae for decreasing the differences to zero, are calculated by the following equations. 

30 Ac = Rmix(c, Xe) * (AXe+AXse) + Rmix(c, Ve) * (AVe+AVse) 

Ae ■ Rmix(e, Xe) * (AXe+AXse) + Rmix(e, Ve) * (AVe+AVse) 

[0169] The program then proceeds to S1208 in which the ZMP parameters c, e are calculated using the following 
35 equations. 

c = cmix + Ac 
e = emix + Ae 

40 

Here, cmix: value of mixed gait parameter c; emix: value of mixed gait parameter e. 

[01 70] Returning to the explanation of the flow chart of Figure 26, the program then proceeds to S1 1 30 in which the 
mixed gait parameters are substituted for desired gait parameters. Here, the values obtained in S1208 are substituted 
for the parameters c, e. The program then proceeds to S1132, via S1 122, in which the instantaneous values of the 
45 desired gait are calculated. 

[0171] Specifically, the program proceeds to S1 300 in a flow chart of Figure 34 in which the ZMP at time t is deter- 
mined using any method in the foregoing embodiments, to S1 302 in which the feet position and orientation at time t are 
determined using any method in the foregoing embodiments, to S1304 in which the body position of the desired gait is 
determined using the following equation. 

50 

x(k) = xmix(k) + Rmix(x(k), c) * Ac + Rmix(x(k), e) * Ae + Rmix (x(k), xO) * AxO + Rmix(x(k), vO) * AvO 

Here, xmix(k): k-th datum in the mixed gait body trajectory time-series tabulated data. Although no explanation is made 
here, the body position in the Y-direction is similarly calculated. The body position in the Z-direction may be calculated 
55 in the same manner as the X, Y-direction values, or may be calculated using the technique described in the application 
filed at the same date as the present invention. 

[01 72] In the manner described above, more specifically, by superposing waveforms shown in Figures 27, 29 to 32, 
the desired gait having the boundary conditions as desired can be generated, as illustrated In Figure 35. In Figure 35, 
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the situations are set as follows. 

c<0, c+Ac <0, e <0, e+Ae >0 

5 [0173] Having been configured in the foregoing manner, the system in the fourth embodiment can generate gaits 
freely on a real-time basis and make the displacements and velocities of robot portions continuous at the boundary of 
the gaits. 

£01 74] Figure 36 is a flow chart showing the operation of the system according to the fifth embodiment of the inven- 
tion. 

w [0175] In the fourth embodiment mentioned above, the body position time-series partial differential sensitivity rela- 
tive to the mixed gait ZMP parameter c_ (Rmix(x(k), c)), the body position time-series partial differential sensitivity rela- 
tive to the mixed gait ZMP parameter e (Rmix(x(k), e)), the body position time-series partial differential sensitivity 
relative to the initial body position (Rmix(x(k), xO), and the body position time-series partial differential sensitivity relative 
to the initial body velocity (Rmix(x(k), vO) are used. So to speak, the fourth embodiment has a model of body trajectory 

15 perturbation in time-series tabulated data relative to the ZMP perturbation. 

[0176] Rather, the fifth embodiment uses a linear dynamic perturbation model (a linear model expressing the rela- 
tionship of perturbations of the body position and velocity relative to a perturbation of the ZMP) described by the follow- 
ing expression so as to accord the boundary conditions on the body position and velocity with the demanded values. 
[0177] The basic principle of this method will first be explained. Although the body behavior and the ZMP trajectory 

20 are discussed only in the to-and-fro direction (X-direction), the same will also be applied to the left and right direction 
(Y-direction). 

[0178] Assume that the mass of the body 24 of the robot 1 is sufficiently larger than that of the other portions and 
that the vertical body acceleration is relatively small during walking. If this specific condition is met, the relationship of 
the body position and velocity perturbation relative to the ZMP perturbation, i.e., the dynamic perturbation model can 
25 be approximated by the following equation, i.e., a linear inverted pendulum model illustrated in Figure 37. As illustrated 
in the figure, the model has a supporting point 22a which is movable. 

dxmdl/dt = v 

30 dvmdl/dt = coO 2 * (xmdl - ZMPmdi) 

Here, xmdl: the position of the center of mass of the linear inverted pendulum; vmdl: velocity of the center of mass of 
the linear inverted pendulum. co0 is a positive constant which is approximated by the relationship between the height of 
the center of gravity of the body h and the gravitational constant g as follows. 

35 

co0 = V(g/h) 

[0179] When the specific condition is met, the linear inverted pendulum model can be used instead of the pertur- 
bation model (which is more general than the above-mentioned model) expressed by Rmix(x(k), c), Rmix(x(k), e), 
40 Rmix(x(k), xO), Rmix(x(k), vO) used in the fourth embodiment. In the following explanation, if the states of the model 
should preferably be described with time, they will be described as xmdl(t), vmdl(t), etc. 

[0180] Based on the above, the operation will be explained with reference to Figure 36. The configuration of the 
ZMP pattern is the same as that in the fourth embodiment. 

[0181] The program starts at S1400 in which the standard gaits have been stored in memory and proceeds to 
45 S1402 in which the final body positions and velocities in each of the standard gaits have been calculated and stored in 
memory. The program then proceeds to S1404 in which the behavior of the dynamic perturbation model is calculated 
up to the final time of the gait, and the final model position Xe and the final model velocity Ve are calculated, setting the 
ZMP parameters, as illustrated in Figure 35, c =1 , e = 0, p (ZMP value at time 0) =0, ZMP values at the other braking 
points =0, while setting its initial states as xO = 0 and vO = 0. 
so [0182] More specifically, this is done by setting Ac (the ZMP pattern correction amount shown in Figure 29) to 1 , 
and inputting, the ZMP patterns as illustrated in Figure 29, to the model to obtain the behavior of the model. Then the 
final states of the model are obtained, and the partial differential sensitivity of the final model position Xe relative to the 
ZMP parameter c (referred to as R(Xe, c)), is calculated as follows. 

55 R(Xe, c) = Xe 

[0183] Similarly, the partial differential sensitivity of the final model velocity Ve relative to the ZMP parameter c, is 
calculated as follows. 
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R(Ve, c) = Ve 

[0184] The behavior of the dynamic perturbation model can be calculated by discretizing the model and then by 
conducting sequential calculation, or can be solved by analysis. 
5 [0185] The program then proceeds to S1406 in which the behavior of the dynamic perturbation model is calculated 
up to the final time of the gait and the final model position Xe and the final model velocity Ve are calculated, setting the 
ZMP parameters c=0, e=1 , p=0. ZMP values at the other braking points =0, while setting its initial states as xOO and 
v0=0. 

[0186] Then, the partial differential sensitivity of the final model position Xe relative to the ZMP parameter e, is Cai- 
ro culated as follows. 

R(Xe, c) = Xe 

[0187] At the same time, the partial differential sensitivity of the final model velocity Ve relative to the ZMP param- 
is eter e, is calculated as follows. 

R(Ve, c) = Ve 

[0188] The program then proceeds to S1 408 in which the behavior of the dynamic perturbation model is calculated 
20 up to the final time of the gait and the final model position Xe and the final model velocity Ve are calculated, setting the 
ZMP parameter c=0, e=0, p=0, ZMP values at the other braking points =0, while setting its initial states as x0=1 and 
v0=0. 

[0189] Then, the partial differential sensitivity of the final model position Xe relative to the initial model position xO, 
is calculated as follows. 

25 

R(Xe, xO) m Xe 

[0190] At the same time, the partial differential sensitivity of the final model velocity Ve relative to the initial model 
position xO, is calculated as follows. 

30 

R(Ve, xO) = Ve 

[0191] The program then proceeds to S1410 in which the behavior of the dynamic perturbation model is calculated 
up to the final time of the gait and the final model position Xe and the final model velocity Ve are calculated, setting the 
35 ZMP parameters c=0, e=0, p =0, ZMP values at the other braking points =0, while setting its initial states as x0=0 and 
v0«1 . 

[0192] Then, the partial differential sensitivity of the final model position Xe relative to the initial model velocity vO, 
is calculated as follows. 

™ R(Xe, vO) = Xe 

[0193] At the same time, the partial differential sensitivity of the final model velocity Ve relative to the initial model 
velocity vO, is calculated as follows. 

45 R(Ve, vO)=Ve 

[0194] The program then proceeds to S141 1 in which the behavior of the dynamic perturbation model is calculated 
up to the final time of the gait and the final model position Xe and the final model velocity Ve are calculated, setting the 
ZMP parameters c=:0, e=0, p=1, ZMP values at the other braking points =0, while setting its initial states as x0=0 and 
50 v0=0. 

[0195] Then, the partial differential sensitivity of the final model position Xe relative to the initial ZMP p, is calculated 
as follows. 

R(Xe, p) = Xe 

55 

[0196] At the same time, the partial differential sensitivity of the final model velocity Ve relative to the initial ZMP p 
(referred to as R(Ve, p), is calculated as follows. 



19 

BNSDOCID: <EP 1018467A1 I > 



EP 1 018 467 A1 

R(Ve,p) = Ve 

[0197] The program then proceeds to S1412 in which based on the sensitivities thus obtained, a 2*2 matrix is gen- 
erated, whose 1st row 1st column element is R(Xe, c), 1st row 2nd column element is R(Xe, e), 2nd row 1st column 

5 element is R(Ve, c), and 2nd row 2nd column element is R(Ve, e). 

[0198] The program then proceeds to S1414 in which the inverse matrix thereof is calculated. In the inverse matrix, 
the element of the 1st row 1st column is the partial differential sensitivity of the parameter c relative to the final model 
position Xe (referred to as R(c, Xe)), the element of the 2nd row 1st column is the partial differential sensitivity of the 
parameter e relative to the final model position Xe (referred to as R(e, Xe)), the element of the 1st row 2nd column is 

10 the partial differential sensitivity of the parameter q relative to the final model velocity Ve (referred to as R(c, Ve)), and 
the element of the 2nd row 2nd column is the partial differential sensitivity of the parameter e_ relative to the final model 
velocity e (referred to as R(e, Ve)). 

[0199] The program then proceeds to S1416 in which the timer is reset to zero and is started, to S1422, via S1418, 
S1420, in which it is determined whether the gait is to be switched. When the result is negative, the program proceeds 
is toS1432. When the result is affirmative, on the other hand, the program proceeds to S1428, viaS1424, S1426, in which 
the gait mixing is conducted. 

[0200] Explaining this with reference to the flow chart of Figure 38 which shows the subroutine of the procedures, 
the program starts at S1500 in which the mixed gait parameters are generated using any method in the foregoing 
embodiments. At this time, one from among the standard gaits whose initial and final body positions and velocities are 
20 close to the demanded values, is selected as the base gait. Then, excluding the initial and final body positions and 
velocities from the directly-determined parameters, the mixed gait parameters are generated or calculated. The pro- 
gram then proceeds to S1502 in which the differences AxO, AvO, AXe, AVe between the initial and final body positions 
and velocities of the mixed gait and the demand values are calculated. 

[0201] The program then proceeds to S1504 in which the final position and velocity AXse, AVse are calculated as 
25 follows, by setting the model initial position and velocity to AxO, AvO, while setting the ZMP to 0. 

AXse = R(Xe, x0) * AxO + R(Xe, vO) * AvO 

AVse = R(Ve, x0) * AxO + R(Ve, vO) * AvO 

30 

[0202] The program then proceeds to S1506 in which the ZMP parameter correct on amount Ac, Ae are calculated 
as follows. 

Ac = R(c, Xe) * (AXe+AXse) + R(c, Ve) * (AVe+AVse) 

35 

Ac = R(e. Xe) * (AXe+AXse) + R(e, Ve) * (AVe+AVse) 

[0203] The program then proceeds to S1508 in which the ZMP parameters c, e are calculated using the same 
equation as was used in S1208. The program then proceeds to S1430, S1432, and to Si 600 and S1602 in a flow chart 
40 of Figure 39 in which the procedures similar to those in the fourth embodiment are conducted. The program then pro- 
ceeds to S1604 in which the ZMP trajectory correction amount is calculated. This will be same as the pattern illustrated 
in Figure 28 if it is changed as c=Ac , e=Ae and the ZMP values at the braking points as 0. 

[0204] The program then proceeds to S1606 in which, setting the initial model position and velocity as 
xmdl(0) =Ax0 and vmdl(0)=:Av0 and ZMPmdl = the aforesaid ZMP trajectory correction amount and by inputting 
45 them to the model, the behavior of the model is determined by sequential calculations. In other words, the current (at 
time t) model position and velocity are calculated using an equation of discretized model based on the preceding (at 
time t - At ) model position and velocity, and on the current (at time t) ZMP trajectory correction amount. In the first con- 
trol cycle, the current model position and velocity are set to xmdl(0) = AxO and vmdl(0) = AvO . As the discretized 
model, it is possible to use a model expressed in matrix form which is generally used in the field of modern control the- 
se ory. 

[0205] The program then proceeds to Si 608 in which the model position is added to the mixed body position as a 
correction amount shown in the following equation, and the desired body position is thus determined. 

x(k) = xmix(k) + xmdl(kAt) 

55 

Here, x(k): the desired body position; xmix(k): the k-th datum in the body trajectory time-series data of the mixed gait; 
and xmdl(kAt): the model position at time kAt. 

[0206] Having been configured in the foregoing manner, the system in the fifth embodiment can have the same 
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advantages as those of the fourth embodiment. 

[0207] To be more specific, since the linear inverted pendulum model is used, the required capacity of memory 
(ROM 84) is less, and the body trajectory perturbation can be obtained on a real-time basis by sequential calculations, 
etc. Moreover, it is possible to easily obtain a strict solution of the model equation and based on the strict solution, it is 

5 possible to predict future behavior without difficulty. 

[0208] It should be noted that, although the sensitivities of the final body position and velocity relative to the ZMP 
parameters can be obtained from the strict solutions, since they include calculations of exponential functions, the sen- 
sitivities should preferably be obtained beforehand and stored in memory so as to reduce the calculation time. 
[0209] Figure 40 is a flow chart showing the operation of the system according to the sixth embodiment of the 

10 present invention. 

[0210] As mentioned above, when the change of the inertial force of the free leg is negligible, in other words, the 
ZMP changes little, even if the initial free leg foot position or the final free leg foot position is perturbed, it is possible to 
simplify the gait generation. The sixth embodiment aims to achieve this. 

[021 1] In the gait defined in this specification, the final time of a gait is the instant at which the free leg lands. The 
is ZMP has still been set at the floor-contact surface of the supporting leg foot. Accordingly, when the final free leg foot 
position is varied, the ZMP parameter need not be varied provided that the inertial force caused by the final free leg foot 
position change is negligible. However, since the initial position of the ZMP pattern is generally set at the toe of the initial 
free leg foot position and orientation, when the initial free leg foot position is changed, the ZMP pattern should therefore 
be varied in response thereto. 

20 [0212] Taking the ZMP parameter change due to the initial free leg foot position change as an example, the opera- 
tion is now explained focusing on the difference from that of the fifth embodiment. 

[0213] The program starts in S1700 of the flow chart of Figure 40 and proceeds to S1710 in which similar proce- 
dures to those of the fifth embodiment are conducted, and then to S1712. The following procedures are added in the 
sixth embodiment in response to the ZMP parameter change so as to satisfy the dynamic equilibrium condition. 
25 [0214] Specifically, in S1 71 2, the behavior of the dynamic perturbation model is calculated up to the final time of the 
gait and the final model position Xe and the final model velocity Ve are calculated, setting the ZMP parameters c=0, 
e=o, p=1, ZMP values at the other braking points = 0, while setting its initial states as xO = 0 and vO = 0, as illustrated 
in Figure 41 . 

[0215] Then, the partial differential sensitivity of the final model position Xe relative to the ZMP parameter p, is cal- 
30 culated as follows. 

R(Xe, p) m Xe 

[0216] At the same time, the partial differential sensitivity of the final model velocity Ve relative to the ZMP param- 
35 eter p, is calculated as follows. 

R(Ve, p) = Ve 

[021 7] The program proceeds up to S1 728 in which similar procedures to those of the fifth embodiment are taken, 
40 and to S1730 in which the gait mixing is conducted. Specifically, the program proceeds to S1800 as shown in a flow 
chart of Figure 42 in which the mixed gait parameters are generated using any method from the foregoing embodi- 
ments. At this time, one from among the standard gaits which is close in the initial and final body positions and velocities 
and the initial and final free leg foot positions and orientations is selected as the base gait. 

[0218] Once selecting the base gait, the mixed gait is generated in the same manner as the foregoing embodiments 
45 by excluding the initial and final body positions and the initial and final free leg foot positions from the directly-deter- 
mined parameters. Consequently, the initial and final body positions and velocities and the initial and final free leg foot 
positions of the mixed gait are the same as those in the base gait. 

[0219] The program proceeds to S1806, via S1802 and S1804, in which the difference between the demanded ini- 
tial free leg foot position and the mixed gait initial free Jeg foot position is calculated and is named Ap. The program then 
so proceeds to S1808 in which, setting the initial model ZMP to Ap and ZMP values at the other braking points to 0, the 
final position and velocity AXpe, AVpe are calculated using the following equations. 

AXpe=R(Xe,p) * Ap 

55 AVpe=R(Ve,p) * Ap 

[0220] The program then proceeds to S1810 in which the ZMP correction amounts Ac, Ae are calculated using the 
following equations. 
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Ac = R(c, Xe) * (AXe+AXse+AXpe) + R(c, Ve) * (AVe+AVse+AVpe) 
Ae = R(e, Xe)*(AXe+AXse+AXpe)+R(e, Ve)*(AVe+AVse+AVpe) 

[0221 ] The program then proceeds to S1 732 of the flow chart of Figure 40 in which the aforesaid mixed gait param- 
eters are substituted for the desired gait parameters. The values obtained in S1 812 is substituted for the ZMP parame- 
ters c, e. The demanded values are substituted for the initial and final free leg foot position parameters. 
[0222] The program then proceeds to S1734, as is shown in a flow chart of Figure 34 in which in S1900 and in 
S1902 the same procedures as those of the fifth embodiment are conducted. With these procedures, feet trajectories 
which satisfy the demands for the initial and final free leg foot positions, as well as the corrected ZMP trajectory, are 
obtained. The program then proceeds to S1904 in which the ZMP trajectory correction amount is calculated. This is a 
pattern illustrated in Figure 44,in which its value c=Ac , e=Ae , p=Ap and the ZMP values at the other braking points 
are set to zero. 

[0223] The rest of the sixth embodiment is the same as the fifth embodiment 

[0224] Having been configured in the foregoing manner, the system in the sixth embodiment has the same advan- 
tages as those in the fourth or fifth embodiment. Moreover, since standard gaits having different initial body position and 
velocity need not be stored in memory, the memory capacity can further be reduced. 

[0225] Figure 45 is a block diagram, similar to Figure 3, but showing the configuration of a system according to the 
seventh embodiment of the invention. The seventh embodiment differs in the calculation of the horizontal body position. 
[0226] In the seventh embodiment, the feet position and orientation, the ZMP and the body height Z at the current 
time (time t) and the states obtained (including body position and velocity) at the preceding time (time t-At), are input to 
a robot motion model (which is comprised of dynamics, kinematics and various conditions of constraint, in order that 
the current value (instantaneous values) of the horizontal body position coordinate (X, Y) be calculated. 
[0227] More specifically, in the seventh embodiment, S2000 to S2016 shown in a flow chart of Figure 46 are con- 
ducted similarly to the second embodiment. The program proceeds to S2100, then to S2104 as shown in a flow chart 
of Figure 47, and returns to the procedures shown in the flow chart of Figure 46. Then, the program proceeds from 
S2018 to S2022 and then to S2200 and onward as shown in a flow chart of Figure 48 and to S2206 in which the mixed 
gait body trajectory (desired body trajectory) is determined by sequential calculation such that the ZMP dynamically cal- 
culated from the motion of the mixed gait body (desired body) and feet accords with the determined ZMP (which is 
determined from the mixed gait parameters). 

[0228] In the initial state of the gait, initial body position and velocity parameters, appropriately set, are used as the 
body position and velocity. Thus, gaits for a single waking step are generated by sequentially calculating values begin- 
ning from the initial body and velocity parameters. 

[0229] This method is disadvantageous in that the volume of calculation is increased and the final body position 
and velocity tend to deviate slightly from the demanded values, but is advantageous in that it can satisfy the dynamic 
equilibrium condition in a strict sense. 

[0230] In the seventh embodiment, the current body height and horizontal body position may alternatively be deter- 
mined such that they satisfy the dynamic equilibrium conditions and the constraint conditions for determining body 
height simultaneously In the foregoing embodiments, the body height is calculated based on the preceding horizontal 
body position so as to shorten the calculation, assuming that the body height would not change greatly within a short 
period. 

[0231 ] The first to seventh embodiments are thus configured such that there is provided a system for generating a 
gait of a legged mobile robot having at least a body 24 and a plurality of leg links 2 each connected to the body through 
a joint 10R(L), 12R(L), 14R(L), comprising standard gait storing means (S10, etc.) for storing, in memory, a plurality of 
standard gaits, for at least one walking step, each comprising a set of parameters including a parameter relating to a 
floor reaction force, gait demanding means (S24, etc.) for making a demand for gait, and gait generating means (S26 
to S30.S100 to S106, S200 to S206, etc.) for generating an approximated gait which satisfies the demand for gait by 
selecting one or a plurality of the standard gaits in response to the demand for gait, and by conducting approximation 
based on the selected standard gait or gaits. 

[0232] It is configured such that said gait generating means generates the approximated gait by calculating a 
weighted average of the selected gaits (S100 to S106, S200 to S206, etc.). 

[0233] It is configured such that said gait generating means generates the approximated gait by using a parameter 
sensitivity of the selected gait or gaits (S500, S600 to S604, S700 to S706). 

[0234] It is configured such that said gait generating means generates the approximated gait by calculating a 
weighted average of the selected gaits and by using a parameter sensitivity of the selected gait or gait (S800, S900 to 
S906, Si 000 to S1 006). 

[0235] It is configured such that said gait generating means includes storing means (S500, S800, etc.) for deter- 
mining an amount of change in one parameter relative to a unit amount of change in another parameter in at least one 
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of the standard gaits, as the parameter sensitivity of the selected gait and for storing the parameter sensitivity in mem- 
ory, and generates the approximated gait by using the stored parameter sensitivity. 

[0236] It is configured such that said gait means incudes describing means (S1 1 04 to S1 1 14) for describing a rela- 
tionship of perturbation of one parameter relative to the parameter relating to the floor reaction force in the standard 
5 gaits, and corrects the approximated gait based on the described relationship of perturbation to generate gaits which 
satisfy the demand for gait in such a manner that at least displacements and velocities in the generated gaits are con- 
tinuous at a boundary of the gaits (S1128, S1200 toS1208, S1130, S1132, S1300 to S1304, etc.). 
[0237] It is configured such that the perturbation of the one parameter is a perturbation of a horizontal body posi- 
tion. 

10 [0238] It is configured such the relationship is described by a linear model. 

[0239] It is configured such that the relationship is described by an inverted pendulum model. 
[0240] It is configured such that the relationship is described by time-series tabulated data. 

[0241 ] It is configured such that said gait generating means generates the approximated gait, without considering, 
(i.e., irrespectively of) the parameter if the parameter is under a predetermined condition (S1730, S1800 to S1812). 

is [0242] It is configured such that said gait generating means includes joint angle command calculating means 
(S302) for calculating a joint angle command of the robot based on the generated gait, and joint controlling means 
(S306) for controlling the joint of the robot such that it traces the calculated joint angle command. 
[0243] It is configured such that said joint angle command calculating means includes detecting means (S300, 
S400 to S404) for detecting a state of the robot, and correcting means (S406, S408, S304) for correcting a position and 

20 a posture of the robot in response to the detected state, and calculates the joint angle command such that the corrected 
position and the orientation are effected. 

[0244] In the first to seventh embodiment, the approximation should not be limited to those disclosed. Rather, var- 
ious modification or alteration will be possible. 

[0245] In the first to seventh embodiments, the body position is represented by a coordinate of a reference point of 
25 the body 24 viewed in the coordinate system set at the supporting leg's floor-contact point The reference point should 
be set at the center of the body 24 in the left and right direction. As regards the to-and-fro direction, the reference point 
can be set using any of the following methods. 

Method 1 ) to set the reference point at the center of gravity of the body (used in the first to seventh embodiments). 
30 Method 2) to set the reference point at the position which will accord with the center of mass of the robot when the 

robot stands upright. 

Method 3) to set the reference point at an appropriate point by trial and error. 

[0246] Any of the methods would not differ if the orientation of the body is constant during walking. However, if the 
35 body orientation changes during walking such as in turning, an error (approximation error) would be different depending 
on the location where the reference point is set. More specifically, Figure 49 illustrates the cases in which the reference 
point is set at the center of the body, and the reference point is shifted right in the sheet Assume a situation where the 
body is rotated about the reference point, it will be understood that the body positions are different from each other if 
the reference point is at the body center, or if the reference point is close to the body front. 
40 [0247] The generation of a mixed gait (demanded gait) has been described taking an example of mixing gaits hav- 
ing different turning angles. The gait mixing is thus a kind of approximation. However, the gait will vary slightly depend- 
ing on the way of setting of the reference point, as mentioned above, and hence, the accuracy of approximation relative 
to the dynamic equilibrium condition will vary. 

[0248] The reference point should accordingly be set such that the error relative to the dynamic equilibrium condi- 
45 tion is as small as possible. Which of the setting methods is optimal or any of the setting method affects little depends 
upon the structure or the nature of walking of the robot. 

[0249] In order to enhance the accuracy relative to the dynamic equilibrium condition, it is alternatively possible to 
use, instead of the time-series tabulated data of body position, time-series tabulated data of the center of mass of the 
robot. If doing so, since the robot posture must be determined such that the center of robot mass accords with a desig- 
so nated position, the volume of calculation will be increased by a significant amount. 

[0250] In the foregoing embodiments, the acceleration has not been described in the gait parameters. Needless to 
say, generated gaits will be even smoother if the acceleration is made continuous at the boundary of gaits. 
[0251] In the foregoing embodiments,although the present invention has been described with reference to a biped 
robot, the present invention can be applied to other legged mobile robots. 



55 



INDUSTRIAL FIELD IN WHICH THE INVENTION IS APPLICABLE 

[0252] According to the present invention, it becomes possible to generate gaits including the floor reaction force 
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freely on a real-time basis and to effect a stride or a turning angle as desired. Moreover, it becomes possible to make 
the displacements and velocities of various robot portions continuous at the boundary of the generated gaits. Further- 
more, it becomes possible to control walking of a legged mobile robot based on the gaits generated on a real-time basis. 

5 Claims 

1 . A system for generating a gait of a legged mobile robot having at least a body and a plurality of leg links each con- 
nected to the body through a joint, comprising 

10 a. standard gait storing means for storing, in memory, a plurality of standard gaits, for at least one walking step, 

each comprising a set of parameters including a parameter relating to a floor reaction force; 

b. gait demanding means for making a demand for gait; and 

c. gait generating means for generating an approximated gait which satisfies the demand for gait by selecting 
one or a plurality of the standard gaits in response to the demand for gait, and by conducting approximation 

75 based on the selected standard gait or gaits. 

2. A system according to claim 1 , wherein said gait generating means generates the approximated gait by calculating 
a weighted average of the selected gaits. 

20 3. A system according to claim 1, wherein said gait generating means generates the approximated gait by using a 
parameter sensitivity of the selected gait or gaits. 

4. A system according to claim 1 , wherein said gait generating means generates the approximated gait by calculating 
a weighted average of the selected gaits and by using a parameter sensitivity of the selected gait or gaits. 

25 

5. A system according to claim 3 or 4, wherein said gait generating means includes; 

d. storing means for determining an amount of change in one parameter relative to a unit amount of change in 
another parameter in at least one of the standard gaits, as the parameter sensitivity of the selected gait and for 

30 storing the parameter sensitivity in memory; 

and generates the approximated gait by using the stored parameter sensitivity. 

6. A system according to any of preceding claims 1 to 5, wherein said gait means incudes: 

35 e. describing means for describing a relationship of perturbation of one parameter relative to the parameter 

relating to the floor reaction force in the standard gaits; 

and corrects the approximated gait based on the described relationship of perturbation to generate gaits which 
satisfy the demand for gait in such a manner that at least displacements and velocities in the generated gaits 
are continuous at a boundary of the gaits. 

40 

7. A system according to claim 6, wherein the perturbation of the one parameter is a perturbation of a horizontal body 
position. 

8. A system according to claim 6 or 7, wherein the relationship is described by a linear model. 

45 

9. A system according to claim 8, wherein the relationship is described by an inverted pendulum model. 

10. A system according to claim 6 or 7, wherein the relationship is described by time-series tabulated data. 

so 11 . A system according to any of claims 1 to 1 0, wherein said gait generating means generates the approximated gait 
by excluding the parameter if the parameter is under a predetermined condition. 

12. A system according to any of preceding claims 1 to 11 , wherein said gait generating means includes; 

55 f. joint angle command calculating means for calculating a joint angle command of the robot based on the gen- 

erated gait; and 

g. joint controlling means for controlling the joint of the robot such that it traces the calculated joint angle com- 
mand. 
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A system according to claim 12, wherein said joint angle command calculating means includes; 

h. detecting means for detecting a state of the robot; and 

i. correcting means for correcting a position and an orientation of the robot in response to the detected state; 
and calculates the joint angle command such that the corrected position and the orientation are effected. 
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